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ABSTRACT 


The following contains results of a study on equations of motion 
for a free-flying teleoperator. Three different kinds of models have 
been developed and analyzed. Equations for each model were obtained. 
Computer simulations were performed to demonstrate the adequacy of each, 
model and the correctness of the equations. Very interesting and 
encouraging results were obtained. Recommendations for further study 
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CHAPTER 1 


INTRODUCTION 

Extending man's reach in space is one of the goals for the space 
program. The Space Shuttle, which makes launching of satellites into 
earth orbit a virtually routine event, will increase man's ability to 
do work in space while contributing to the economy of space operations. 
It will be a space transportation system designed to carry out various 
missions in earth orbit. One possible way to fulfill these mission 
objectives is to use a teleoperator. 

A teleoperator is defined to be a remotely controlled cybernetic 
man-machine system designed to augment and extend man's sensory, manipu- 
lation, and congruitive capabilities to a remote and hostile environment 
while controlled by a man from a more benign and convenient location 
such as a nearby spacecraft or a ground based station. The intervention 

f 

of man in the system can be made "minimal" if the machine possesses 
sufficient artificial intelligence and dexterity to perform the intended 
activities. Figure 1-1 shows this concept.^ 

The use of space shuttle and free-flying Teleoperator (FFTO) will 
allow practical maneuvering of masses in outer space. A satellite that 
is to be retrieved will generally have some initial angular motion. 
Before the satellite can be retrieved, it will be necessary to null its 
angular rates. The angular motion of a satellite can be expressed at 
any instant as the resultant of a spin component and a tumble component. 
If one of these components is zero, the satellite is in a state of pure 
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spin or pure tumble. Utilizing a teleoperator to null pure spin or pure 
tumble is straightforward. The problem is more complicated, however, 
for the general case where both spin and tumble are present. 

If a disturbance-free service is to be performed on a satellite 
which is functioning normally, the teleoperator needs first. to maneuver 
itself to match to the dynamics of the whole satellite. .Furthermore, 
the arms and hands of the teleoperator also need to catch up with the 
area on the satellite, where service is to be performed. A detailed 
knowledge is needed of the required teleoperator maneuvering, including 
an m-depth analysis of its kinematics and dynamics. 

This knowledge is needed of the dynamics of various satellites 
in their normal operational modes and in their failure modes. For 
example, when a satellite loses its attitude control, it may" have un- 
stabilized three-axis motion such as spinning and tumbling. Knowledge 
of these dynamics is the prerequisite to the development of teleoperator 
specifications. 

The resulting dynamics of the combined system of teleoperator and 
satellite, after contact has been made, needs to be studied. The result 
of this study will determine the attitude requirements for. a teleoperator 
and also provide the information needed for the design of arm and hand 
mechanisms for successful despinning and detumbling of a. satellite. 

The purpose of this study is to develop a set of equations which 
describe the state of the manipulator , the teleoperator, .the satellite, 
and the combination of teleoperator and satellite. These equations will 
be useful for further study of the teleoperator operation via computer 


simulations . 
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Chapter 2 of this report contains the equations relating the 
position and velocity of the manipulator's hand to its base at tele- 
operator body. 

Chapter 3 describes the nulling of a satellite's initial angular 
motion under the ideal condition that the teleoperator. is stationary. 

Chapter 4 presents the set of dynamic equations which. describe 
the combined motion of the teleoperator and the satellite. 

Chapter 5 summarizes the results of the study and offers recom- 
mendation for further investigation. 

All computer programs are written in CSMP (Continuous Simulation 
Modeling Program). They are included in appendices. 



CHAPTER 2 


MANIPULATOR KINEMATICS 


Manipulator Model 

A manipulator mode!, shown in Figure 2-1, is chosen as the basic 
model for the present study. This model is composed of two arm sections, 
a shoulder, and a hand. The manipulator has two bending joints and two 
swivel joints which are conceptually shown in the figure. Four rotational 
freedoms exist, they are represented by the angles , a 2 , and 
Counter-clockwise rotation is considered the positive sense. 

Six coordinate frames 

s j • (x i , y i , z i ) , i = 1 to 6 , 

are defined in Figure 2-1. Frame S-, is hand-fixed while frame S. is 
FFTO-fixed. These coordinate frames help to formulate the position and 
velocity of the hand with respect to various parts of the manipulator. 

Position Vectors for Finger Tip and Hand 

Referring to Figure 2-1, the finger tip position in coordinate 
frame S ] is given by 



(2-1) 
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The position in coordinate frame Sg is obtained from (2-1) through a 
linear transformation given by 
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4 = [0 0 - (2-4) 
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where [ ] represents the transpose of a vector or matrix. The finger 

tip position in coordinate frame S 3 is 
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where 
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Proceeding in the similar manner we can obtain the finger tip 
position in coordinate frames S A , Sg S and $g as 


where 


14 = 4 + 4 
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4 = c° 


( 2 - 12 ) 
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and 


^ = [0 0 £ 4 ] t 


(2-13) 


Combining Equations (2-1) to (2-13), the finger tip position 
expressed in FFTO-fixed frame is given by 


^6 = T 65 T 54 T 32^-1 + -l 1 + T 65 ] 54-3 + T 65^4 
By defining 


T 64 T 65 T 54 

T 62 = T 65 T 54 T 32 


(2-14) 


(2-15) 


(2-14) takes the simple form 

' ! 

Ig = T 62^1 + ~z) + T 64 -3 * T 65^4 - (2-16) 

Notice that, while t ^ , £ 2 , £3 anc * are constant vectors, all the 
transformation matrices I- - are variable since they involve variable 

* J 

angles. 

The position of hand can be obtained in a similar way. Let h_. , 
i = 2 to 6, be the position vector of hand in coordinate frame , we 


have 
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hg = l 2 

—3 = T 32— 2 
jXi “ JX3 + —3 
hg _ 1 54-^1 
*6 - T 65 <*5 + ^ 4 > 


(2-17) 

(2-18) 

(2-19) 

(MG') 

( 2 - 21 ) 


Combining (2-17) to (2-21), gives the hand position expressed in FFT0- 
frame 


^6 “ T 62 -2 + T 64 -3 + T 65 ^4 


( 2 - 22 ) 


Velocity Vectors for Manipulator's Finger Tip and Hand 

By taking the derivative of (2-16) and (2-22) the velocity vectors 
for manipulator's finger tip and hand are given by, respectively, 




+ 1 %) + T e$ £-3 + T 65 £4 


(2-23) 


and 


^6 


= T 62 -2 * T 64 —3 + ^65 ^4 


(2-24) 


Both (2-23) and (2-24) are functions of angular rates e 2 , o-j and <x 2 . 
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Acceleration Vectors for Finge r Tip and Hand 

By taking the derivative of (2-23) and (2-24) the acceleration 

vectors for manipulators finger tip and hand are obtained 


^6 


^62 (-1 


+ ? ) 


T 6f -3 


T 65 b 


(2-25) 


He 


" T 62 -2 


+ T 


64 -3 


+ T 65 b 


(2-26) 


Uniqueness Consideration 

Corresponding to a given set of angles e 2 , a ] and the hand 
position hg and finger tip position fg are unique. On the other hand, 
given a desired hand or finger tip position, the set of angles is in 
general not unique. The non-uniqueness creates ambiguity in generating 
control signals. This difficulty can be eliminated by defining a spe- 
cific sequence of angular rotations at different joints. 

Define a set of polar coordinates for each coordinate -frame as 
shown in Figure 2-2 where the coordinates are represented by (r., 0 i » ^)» 
i = 1 to 6. Then a possible sequence of angular movement can be estab- 
lished as follows. 

1. At the beginning, the manipulator is in a folded 
position. 

2. For a given fg, the desired distance f g between the 
shoulder bending joint and the finger tip can be 


determined from 
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f 5 = |ie ' k\ < 2 - 25 ) 

3. Rotate the base swivel joint until = s r . 

c. v 6 

4. Rotate the forearm bending joint, in the direction 
where a-j is positive, until the distance f g is 
obtained. 

5. Rotate the shoulder bending joint until 

The finger tip is now at the desired position. 

If it is desired to catch the object with the hand oriented in a dif- 
ferent direction, the direction of the angle , in Step 4 can be 
reversed. 

If visual aid equipment is available, the control of hand po- 
sition is made easier with the help of remote human guidance. 



CHAPTER 3 


■SATELLITE’S EQUATIONS OF MOTION 
1. PRELIMINARY REMARKS 

A satellite is assumed to possess an initial angular velocity 
which is the combined motion of tumbling and spinning. An external 
moment is applied on the satellite to despin and detumble until its 
angular velocity is nulled. There are several ways to accomplish the 
despin-detumble operation. The dynamics of the satellite during despin- 
detumble process is studied in this chapter. The study includes the 
development of the satellite’s equations of motion for different cases. 
Methods of applying external moments are discussed. Then, computer simu- 
lations are made to reveal the dynamic properties. 

It should be mentioned that some of the results of this chapter 
are available in Reference 4. But the derivation is different. Further- 
more, the inclusion of this study allows a better understanding, of the 
operation of a teleoperator system. 

2. EQUATIONS OF ROTATIONAL MOTION 

This section presents the general equations of rotational motion 
for the satellite. Referring to Figure 3-1, two coordinate frames are 
defined. The inertial coordinates are denoted by (X, Y, 1 ) while the 
body coordinates are denoted by (x, y, z). The origin -0 of the body 
frame is at the center of mass of the satellite. 
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The equations of rotational motion can 


then be written as 


7 


M x ■ ! xx “x + V"y - “A 1 + J xz (i 2 + “A 1 


2 2 

+ (I - I } 01 + I,,_((D W “ W,} 

yy y 2 yz y 2/ 


( 3 - 1 ) 


M y ' V ( “x + Tj 1 + V “y + r yz ( “z ’ “A 1 


+ (I xx ‘ W “x“z + ‘xz<“z ' ”x> 


( 3 - 2 ) 


", = ‘xz ( “x ' Vz 1 + VV + Vz 1 + 1 zz “z 


+ O yy - I xx ) » x » y + Ixy(» x - »y) 


( 3 - 3 ) 


In these equations, ui ^ 5 ai y , are absolute body angular rates along 
body coordinates x, y, z, respectively. I xx > Iy y , and I zz are. moments 
of inertia of the satellite, taken with respect to x, y, and-Z axes. 
I x y, I , and l xz are products of inertia. M y , M y > and M z are applied 
moments along x, y, and z axes. 

For a given set of initial conditions and a known applied moment 

M = [M , M , M ]^, one can, in theory, solve for = [e , a , w ] as a 
x y z *** j> 

function of time. In general, however, this is a difficult procedure. 
On the other hand, if the angular rate <u is given, the calculation of 
the required external ,mome nt is usually a 'straightforward procedure. 
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It should be noted that the time integrals of and a> z do 

not correspond to any physical angles which might be .used to give the 
orientation of the body. To solve for the orientation, -one must trans- 
form continuously to another set of coordinates. Or, one may solve the 
rotational equations in terms of the other coordinates -from -the beginning. 
One set of such other coordinates are the set of three Euler tangles . 

They are three successive angular displacements which can carry out the 
transformation from one Cartesian system of axes to another. The three 
body angular rates & , w » and co can s be expressed in terms of Euler 
angles and their time derivatives. 

The Euler angles used in this study are ip, e, and <j>,,in the 
sequence as shown in Figure 3-2. The transformation -from X,-Y, Z to 
5' > n'» c 1 system, representing a rotation of angle about the Z-axis, is 
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■ COSiJj - 

si niii 
1 

n 1 

= 

-sin^ * 

COSlJl 

. c ‘. 
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(3-4) 


The transformation from n' s c' To n 9 C system representing a ro- 
tation of angle 6 about c'-axis, is 
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n 
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Finally, the transformation from £, n> C to x, y, z system, representing 
a rotation of angle <j> about s-axis, is 


x 

y 

z 


cos<j> 
-si n<p 
0 


sin<£ 

cos<j> 

0 . 


0 

0 

1 


£ 

n 
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(3-6) 


Combining (3-4), (3-5) and (3-6) gives the transformation from X, Y, Z 
to x, y, 2 system as •' 


- *■ 

X 


X 

y 

= R 

Y 

z 


Z 

- 


, 


where R is a matrix given by 


(3-7) 


R = 


cosipcos£ - sini|>cosesin<£ - 
-cosi/jsinij) - simj>cosecos<f> 
sin^sine 


sin$cos<j> + cosi|jcosesin<|> 
-si m/>sin4> + cos4>cosecos<t> 
-cosij>sin0 


sinesin 9 

sin0cos<j> 
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(3-8) 


Notice that R is orthogonal, therefore the inverse of (3-7) is 
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= R t 

y 
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(3-9) 
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f 

where R is xhe transpose of R. 

The directions of Euler angular rates jp, e and l with. respect to 

satellite body are shown in Figure 3-3. These three angular, rates are 

sometimes called precession, nutation and spin, respectively. 

The angular rates ca , w , and id can now be written in terms of 

x y z 

Euler angles and their rates as 


a = ip sine sin<*> + e cos<f> 

X 

w = iji sine cos<f> - e sin<j> l 
= Ui cose + <f> 


(3-10) 


The angular rate is sometimes called the "total spin" which should 
not be confused with the spin rate <ji. 

f 

To facilitate the analysis, a special case is considered first. 
Then the analysis of the general case follows. 

3. SATELLITE WITH AXIAL SYMMETRY 

Consider a satellite body having axial symmetry, and assume that 
only a spin rate <+> exist under nominal condition. The xyz frame is re- 
defined with its origin at the mass center of the satellite and with its 
z-axis along the spin direction. Under the nominal condition the xyz 
frame is stationary with respect to the inertial frame. Thus the xyz 
frame can be considered as a set of principal axes for the satellite. 
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Hence, an arbitrary rotation of the body relative to this coordinate 
system will not cause the moments of inertia to change, since the rota- 
tion can always be resolved into components about the axes of symmetry. 
Denoting 


(3-11) 

the components of angular momentum can be written as 




(3-12) 


where u* , -u‘ are components of the absolute angular rate of the body, 

expressed along xyz axes. Now suppose that the body rotates about the 
z-axis with an angular velocity measured relative to. the xyz system. 

Let the absolute angular velocity of the xyz coordinate system be « = 
fry «o , co z 3 t , which is related to by 

“i = “x 

“y = “y / • (3-13) 

= C0 2 + <£ 
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Illation (3-12) can then be written as 


H x - ! t “x 


H y ■ “y 


H z = I a (» z + ♦) 


(3-14) 


»ing the relative angular momentum equation 


H = (H) r + to x H 


(3-15) 


id the moment equation 


M = H 


(3-16) 


set of modified Euler equations are obtained 


■ h “x ‘ (I t - I a ) “y“z + h* a y 


• ^ 


= ! t “y + ' (I t ' I a ) “*“z ' 


x > 


(3-17) 


1 Z - I a (i 2 + t) 
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where M x , and M z are components of the vector moment M resolved along 
xyz coordinates. Assuming- there is no rotation of the xyz coordinates 
along the z direction relative to the XYZ frame, then (3-10) becomes 

* 

' • 

to = 6 
X 

Wy = ip sine 
i» z = \p cose 


(3-18) 


Differentiating (3-18) and substituting the result into (3-17), gives 


m n 

= 1.6 + I (a + ill cose)ijj sine - I. y sine cose 

t a t 


M w = I. (a sine + e .cose) + I. e ^ cose - I (| + $ cose)e 

V t l a 


(3-19) 


M z = I (p + t cose - i|i e sine) 


The above set of equations will be used to simulate .different 
cases of the operation of angular rate reduction of a satellite. 

A. Combined Despinning and Deconi ng 

In this case it is assumed that the satellite is in coning motion 
which is a combined result of spinning and tumbling. Jt is further 
assumed that the coning is without noding. Under this condition, by a 



suitable choice of x and y coordinates, the total angular momentum of 
the satellite can be expressed as 
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H = 


H x V 


V 


k H. 


(3-20) 


where 



H = I, sine 

J ** 

H_ = I a (4> cose + $) 

Z a ✓ 


(3-21) 


and i, j, k are unit vectors associated with the xyz coordinates. 

For this case the external moments are applied in. such a way that 

r 

the spin rpte l and coning rate i|» decrease simultaneously while the 
coning angle e is maintained constant. (See Figure 3-4(a)) The desired 
external moments should be 


M x -0 

My = -k I t sine 

= -k I (4> cose + $)' 

Z a 


(3-22) 
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where k is a positive proportional constant taken to be 


M 

k=y^ ' (3-23) 

x t 


B. First Detumblinq Then Despinning 

The tumbling rate is the vector sum of and given by 


(i) = i w ■ + j to 

-xy x J y 


(3-24) 


as shown in Figure 3-4 (b ) - To perform, detumbling, the external moment 
should be applied in a direction opposite to Therefore, with 'the. 
help of (3-14) and (3-18), 



My = — M o ^ sine > 
M = 0 

Z. ^ 


(3-25) 


where M q is a positive proportional constant. 

After nulling to xy , a moment is applied to zero the total spin 
rate u z . The applied moment is given by 


M x “ 0 
M y = 0 

M z •= -H + 


(3-26) 
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where ts a positive proportional constant. 

It has been found, through simulation, that the applied moments 
could be a linear functions of or 8, in order to avoid producing 

new rates which are opposite to the nulled ones. However, -the best 
detumbling results were obtained for a moment which was -a. linear func- 
tion of the coning angle 8. Further discussion will be presented in 
the simulation section of this chapter. 

C. First Despin Then Detumble 

The analysis for this case and the way external moments are 
applied are similar to those discussed for Procedure B, except that the 
operation is done in reverse order. 

4. THE GENERAL CASE 

The moment equations for the general case are obtained by sub- 
stituting (3-10) and its derivatives into (3-1), (3-2) and (3-3), giving 

/ 

M = I [i sine sin<j> + $ e cose sin<f> 

X XX 

+ ip sine cos<*> + e cos<j> - e $ sin<{>] 


+ I^y C’l' sine cos<£> + 0 cose cos<j> 


ip | sine sin<!> - esin^-el* cos<f> 


- (ij. sine sin4> + e cos$) (iji cose + <£)] 
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+ I [t!> cose - * e sin0 + * 
xz 


+ (* sine si n<j> + e cos 4 >) (* sine cos.? - 0 sin$)] 


+ (i - I ) si 
K zz yy 


sine cos* - 0 sin*] (* cose *)■ 


+ i [ (4> sine cos* - e sin*) 2 .- (* cos9 + *^ ^ 
yz 


m = i [i sine cos* + * e cose cos* 

y yy LV 


- •* * sine sin* - 6 sin* - e * cos^] 


+ I [J cose - 4> e sine + * 


- (* sine sin* + e cos*) (* sine cos* - e sin*)] 


+ I [* sine sin* + * e cose sin* 
yx 


+ * * sine cos* + e>-cos*'- e * sin* 


+ (* sine cos* - e sin*) (* cose + *)] 


{I - I ) [* sine sin* + e cos*] (* cose + *) 

XX zz 


+ I [(* cose + *) 2 - (* sine sin* + e cos*) 2 ] 
zx • . < • 


(3-27) 


(3i28) 
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M 


z 





O cose - e sine + <f>] 

[ip sine si n<j> + t]» e cose si n<+> 

+ 1 J 1 l sine cos<j> + e cos$ - e § sin<j> 

- sins cos<f> - e s i n<f> ) cose + <|>)] 
sine cos<j> + ^ e cose cos<j> 


- ij) <j> sine sin<j) - e sin<*> - e i cos? 

-+ (ijt sine sin<j> + 6 cos<j>) cose + $)] 

-5- (I - I ) [ii sine sin^) + e cos<j>] 
v yy xx 7 LV 

f 

x (ip sine cos$ - e sin<j>) 

+ I [(i sine sin$ + e cos<j») 2 - sine cos$ - e sin<p) ] (3-2! 

Note that is is difficult to apply moments expressed along xyz 
coordinates. To get around this difficulty the nodal coordinates 5, n> 
and c are used for expressing the components of applied moment. Using 
the inverse of the transformation (3-6), one has 



-sin4 0 

cosd 0 
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(3-31 


Substituting (3-30) into (3-27) , (3-28) and (3-29), .gives the set of 

v . * 

rotational equations of motion in nodal coordinates. * 

5. SIMULATION BY COMPUTER 
Simulation Condition 

The satellite dynamics for the axial symmetry case has been simu- 
lated using digital computer. First, equations in (3-15) are solved ft>r 
it and 4, The yaw } ted t&yee eqxnws for s'^]st:ou 

MM tSMHltel « sc tw tn«t tf* C0»mj angle * «"»«»** that 1s 


•. * e o ‘ 0 


Solving the first equation of (3-19), gives 


»„ ' siM 0 [I a *o + *o cose o (1 a ‘ ^ “ 0 


Since 4> Q sin© 0 it requires 


l a $ 0 + cose o (I a " l t> = ° 


Thus, 4 0 can be s 


olved if 4 0 is known, vice versa = 



32 


The set of initial conditions and parameter values used for the 
simulation are shown below. 

Initial Conditions 


= 1.1486 radians = 65.81° 
o 

+0 * 0 
■ 0 

e Q = o 

^ = 0.4809 radian/second 

' = 4.19 radians/secopd 

Moments of Inertia 

I a = 9529 kg-m 2 

> 

I t = 212129 kg-m 2 

Proportional Constant 

M q = 800 kg-m 


(3-34) 


(3-35) 
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The following quantities are computed and/or recorded 
simulation. 

1. The magnitude of the total angular momentum 
given by 



2. The drift angle 6 that H makes with the Z-axis, 
given by 


tang = 


XY 


where H^y is the component of H_ in the XY-plane 
and is the component of H. along the Z-axis. 
Since 


H-, = H cose + H w sine 
Z z y 


H xy = y«2 + (H y cose - H z sine) 2 


ing the 


(3-36) 


therefore 
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tan£ 


J (i t 5) 2 + [l t iij sine cose - ($ + <j>cose) sine - ]^ 

I (£ + ^ cose) cose + I. -ip sin e 

a t 


3. The tumbling rate where 


ai 


xy 


=J> \ + “y = / s 2 + sin 2 e 


4. The total spinning rate w given by 


(o=^ + ^ cose 


5. Total work Wj at each instant. 

6. Coning rate 

7. Spin rate 4>, which is related to the total spin 

rate io z via i 

w z = $ + cose' 

8. Coning angle e. 

Results of Simulation 

The results of simulation plotted in Figures 3-5 to 3-15. 
tents of each figure is listed below. 


(3-37) 


(3-38) 


(3-39) 


(3-AO) 


Con- 



Figure 3-5. Time responses for the "detumble-then-despin" case. 
Tumble rare w 
Total spin rate w 2 
t Spin rate | 

Figure 3-6. Time response for the "detumble-then-despln" case. 

t 

(Continuation) 

Coning angle 0 . ’ 

Coning rate ip 

Total angular momentum H 

Drift angle g 

Figures 3-7 and 3-8. Similar to Figures 3-5 and 3-6, but for the 
"simultaneous despin and decone" case. 

Figures 3-9 and 3-10. Similar to Figures 3-5 and .3-6, but for 
the "despin-then-detumble" case. 

Figure 3-11. A plot of the values of the drift angle g versus 
the proportional constant M q for all three cases 
having the same end condition. 

Figure 3-12. A plot of the values of proportional constant M q 
versus t for all three cases having the same end 
condition. 

Figure 3-13. A plot of total work at any time versus time for 

all three cases having nearly the same end condition. 

Figure 3-14. A plot of total spin rate versus the total work 
for all three cases. 

Figure 3-15. A plot of tumble rate « versus the total .work for 


all three cases. 
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Figure 3-9. Time Response for "Despin-then-Detumble" Case 
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Figure 3-11. Drift Angle Versus M Q 
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Figure 3-12. Proportional Constant Versus Time. 
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Figure 3-15. Tumble Rate Versus Work 



Discussion of Results 


The simulation shows that detumbling results in a decrease in 
coning angle. On the other hand, despinning results in an increase 

i 

coning angle. This can be explained by noting that detumbling alone 
reduces H xy while H z stays constant, therefore the angle between H < 
iL» is the coning angle, is reduced. Despinning alone reduces f 
while H X y stays constant, therefore increases the coning angle. 

The change of coning angle causes a drift of coning axis. It 
possible to exert torque at suitable instants for drift correction 4 . 
However, in the present simulation, no drift correction .torque is use 
This is due to the fact that, although it is a simple matter to do sc 
Lheory, the practical application of this procedure is difficult. Th 
drift correction involves the application of torque at particular pos 
tions and these positions are hard to detect. 

In one detumbling simulation, different values of the proporti 
constant M Q were used to determine the behavior of the drift angle g. 
The result is plotted in Figure -3-11 showing that no noted increase i 
8 due to the increase of M Q . Also recorded from this simulation is t 
time required for detumbling to reach a specified state versus values 
M 0 * The , resu 1t is plotted in Figure 3-12 showing that the relationsh 
between M Q and t is such that M Q t = constant. Therefore the detumblii 
time and the proportional constant for moment could be determined fron 
one another when one of the two is specified. Table 3-1 lists the nun 
ical data obtained from this simulation. 



Table 3-1. v Data for Detumble Simulation ' 
(Same end condition) 


M t g W T 

o _ 1 

kg-m seconds radians kg-m 


20 

4950 

0.10833 

35897 

200 

495 

0.10848 

35904 

800 

125 

0.10170 

35700 

1600 

67.5 

0.12030 

I 

38000 

3000 

33 

t 

0.11334 

35907 ~ 


















The total works required for nulling the motion of the-satelli 
versus time are different for different detumble-despin -procedures as 
shown in Figure 3-13. The detumble-then-despin and the simultaneous 
despin and decone cases are very-close. The least work case is the 
despin-then-detumble procedure. 

Computer Programs 

All the computer programs are written in CSMP (Continuous Simp 
lation Modeling Program). They are contained in Appendix 1. 


CHAPTER 4 


STABILIZATION OF FREE-FLYING 
TELEOPERATOR DURING DESPIN 
AND DECONE OPERATION 

1. SYSTEM CONFIGURATION 

Figure 4-1 shows a combined system of a FFTO, and a satellite for 
despin-decone operation. The despin and decone torques are applied 
simultaneously to the satellite by the FFTO through the wrist and 
shoulder brakes. During the despin-decone operation the arm angle a-j 
and cj 2 are locked rigid. Other symbols shown in the figure are defined 
as follows: 

= distance between the wrist brake and the satellite's 

center of mass o . 

s 

^2 = length of FFTO's forearm. : 

= length of FFTO's rear-arm. 

£4 = length of FFTO's shoulder. 

£5 = distance from the shoulder brake to the FFTO's 
center of mass 0 . ' 

0 = a 2 - aj ■ 

£ s f= distance between o g and 0 . 

The reaction torque received by the FFTO during the despin-decoi 
operation is counteracted by a set of control jets produced by clusters 
of thrusters mounted on the FFTO as shown in Figure 4-1. However, the 
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thrust level of each thruster is limited, therefore an effective stab 
zation of the FFTO requires the simultaneous control of the control j 

and the brake forces. 

1 ; 

2. COORDINATE SYSTEMS 

Five coordinate systems are defined here, with the help of Fig 
4-2, for the convenience of the ensuing analysis. 

XYZ-system: This is an inertially fixed coordinate system who 

X, Y, and Z coordinates are fixed with respect to distant stars.' 

xyz-system: This coordinate system is fixed to the body of thi 
FFTO. The x, y and z coordinates are along three principal axes of tl 
body, with the origin 0 of the coordinates located at the mass center 
of the body. 

x s y sV systeni; 1S ^'xed to the body of. the satell 

The x £ , y s , and z £ axes are along three principal axes of the sateTli 
with the origin 0 £ of the coordinates located at -the mass center of tl 
satellite body. 

abz-system: This system has 'its origin coincided with-the oric 
of the xyz-system, but the orientation of its three axes are. fixed wil 
respect to the FFTO's arm. The a-coordinate lies in the arm plane win 
is formed by three arm sections. The z-coordinate is the same as thai 
for xyz-system. The b-coordinate is perpendicular to the arm plane. 
The relationship between xyz and abz systems is therefore a rotation c 
angle y along the z-axis as shown in Figure 4-3 (a). 







a b z s -system: This system has its origin coincided with the 

origin of the x s y s z s -system, but the orientation of ixs three axes are 
also fixed with respect to the FFTO's arm. The a s -coordinate also lie 
in the arm plane, the z s coordinate is the same as that for * s y s V sys 
and the b $ coordinate is perpendicular to the arm plane. The -relation 
ship between x^ and a^ systems is a rotation-of angle y s along 
the z s -axis as shown in Figure 4-3(b). Since both b and-b^axes are 
normal to the arm plane the orientation relationship -between- abz and 

a s b s z s s y stems can be denoted by an angle 0 as shown_1n Figure 4_3(c) ‘ 
If V is a vector in space, its representations in various coorc 

nate systems are related by the following sets of transformations: 




V Y 


COSY 

-siny 

0 

— 

V a~ 


Y 



X 

V y 

= 

sinY 

COSY 

0 

v b 

T abz 

xyz 

\ 



_ V z 


0 

; *0 

1 

- 



\ 











* 


V al 


COSY 

s'inY 

0 




V 



v b 

= 

-sinY 

COSY 

0 


v y 

_ T xyz 
" 'abz 

v y 


- 

\ 


_ 0 

0 

1 


A 


A 

'\s 


' C 0 SY $ 

sinY s 

0 ” 


V 

a b 

A 

V 

= 

-sin Ys 

COSy s 

0 


V bs 

= T 

x s y s z s 

V zs 



0 

0 

1 


V zs 







(4 


(4 


(' 
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■v«' 


COSY s 

-sinY s 

v bs 


siny s 

cosy s 

V 


0 

0 

zs_ 

. 




0 

0 

1 


xs 


ys 


= T 


Vs z s 

a s b s z s 


xs 


■ys 


zs 


zs 


(4-2b) 


' V a' 

1 

COS 0 

0 

sine 


'V 

a b z 

' V as' 

V b 

= 

0 

1 

0 


v bs 

T s s s 
abz 

V bs 

V z 


-sine 

0 

cose 


V zs 


V zs 


V 

V 

V 


as 

bs 

zs 


r . " 




- 

cose 0 -sine 


V a 


V a 

o 
■ — ■ 
o 


V b 

T abz 
‘ 'abz 

V b 




s s s 


sine 0 cose 


V z 


V z 


(4-3a) 


( 4— 3b) 


r~ 

X 

i 


c n 

C 21 

C 31 

v y 

= 

C 12 

C 22 

C 32 

.v 


_ C 1 3 

C 23 

C 33_ 


‘V 


c n 

o 

ro 

C 13 

V Y 

= 

C 21 

C 22 

C 23 

' l 

M 

> 

l 


C 3l 

C 32 

C 33 



t xyz 

xyz 








(4-4a) 


(4-4b) 


In these equations the subscripts denote the coordinates along which the 
vector components are resolved. Matrix element C^- represents direction 


consine. 
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3. KINEMATIC RELATIONSHIPS 

In this section the kinematic relationships between various , 
variables of the satellite and that of the FFTO are developed. 

Let K, «,) and < v » z > be the absolute angular veloci 

> x y ^ u w * 

ties of the FFTO resolved along xyz and abz coordinates, .respectively . \ 
They are related by the transformation (4-lb), that is. 


F 1 
“a 


cosy 

siny 

o' 


^X 

% 

= 

-siny 

cosy 

0 


iO 

y 

(0, 


0 

0 

1 


“z 

z 






J 


Similarly, let (v^, v ys , v z$ ) and (v as , v b$ , v zs ).be the absolute 

angular velocities of the satellite resolved along x s y s z s - and a $ b s z $ 

coordinates, respectively. They are related by the transformation (4-2b), 

r 

that is. 





• 

*■» 

. 


r 

<: 

W * 


c °sy s 

-siny s 

0 


v xs 

v bs 

= 

siny s 

cosy s 

0 


V 

v zs 


0 

0 

1 


v zs 


Finally, let (u a> v b » v z ) and (n as# v bs » u zs ) be the absolute 
angular velocities of the arm resolved along the abz and a $ b s z s coordi- 
nates. Since the az-plane (arm plane) leads xz-plane by the time varying 
angle Y as shown in Figure 4-3(a), the arm rotates with respect to the 
FFTO at an angular velocity y along the z-axis. Thus we have 
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’ y a‘ 


“a 


' 0 “ 


= 

% 

+ 

0 

. V 


.“z. 


Y 

c 

J 





FFTO arm w.r.t. 

FFT.O 


(4-7) 


Also, since the az -plane (also the arm plane) lags x s z s -plane by the 

A O 

time varying angle y s as shown in Figure 4-3(b) # the arm-rotates with 
respect to the satellite at an angular velocity -y s along the z s -axis, 
giving 



arm 



satellite 1 arm w.r.t. 

satellite 


(4-8) 


Notice that the two angular velocity vectors (v a , v b » v z ) and (v as , u bs > 
y zs ) are related by the transformation (4-3a). That is, 


• 


- 



y a 


cose 0 sine 


y as 

y b 

= 

0 1 o 


u bs 

y z 


-sine 0 cose 


y zs 


(4-9) 



5 : 


What we are after is the relationship between (w x , <>y to z )» the 
angular velocity of the FFTO, and (v xs » \> y$ , ^ zs )» the angular .velocity 
of the satellite. This is accomplished by substituting (4-5) -into (4-7 
and (4-6) into (4-8), and then substitute the two resulting equations 
into (4-9). The final expression is 



Or, in the expanded form, 

I 

Y = - (to v cosy + m siny) cscQ 

+ (v xs cosy s - v ys siny s ) cote 

Y = -to + (w cosy + 03 siny) cote 

z x y 

\ ; i 

- (v xs cosy s - v ys siny s ) csce 


( 4 -* 
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-u» x siny + u cosy = v x$ siny s + v^ s cosy $ (4-13) 

Since the rotational and translational motions are coupled, it is 
necessary to include the kinematic equations for translational motion. 

Let (X f , Y.p Z f ) be the position of the FFTO's mass center and (X s> Y s , 

Z ) be that of satellite's mass center. The following relationship 
exists. 


X s = X f - ^sf C 13 

(4-14) 

Y s = Y f " Z sf C 23 

(4-15) 

Z s = Z f “ l sf C 33 

(4-16) 


In summary, for this Satellite-FFTO system, there are eight 
degrees of freedom. Among them a> x , to , to 2 and X^, Y^, Z^ are used to 
describe the rotation and translation motion of the FFTO, respecti vely . 
The other two are y and y s which are used to describe the spinning 'and 
coning motion of the satellite with respect to the FFTO. For this 
eight-degrees-of-freedom system, which will have fourteen variables 
(including to x , w , « z , v x$ , v y$ , v 2S , X f ; Y f , Z f , X $ , Y $ , Z s , y and y s ). 
Equations (4-11), (4-12), (4-13), (4-14), (4-15) and (4-16) are the 
necessary 14 - 8 = 6 constraint equations. The fourteen variables will 
be involved in the formulation of dynamic equations later. 
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4. THE BRAKE MODEL 

The brake model which is used as wrist brake and shoulder brake 
is shown in Figure 4-4, in which mass A is lined up with mass.B with th, 
brake works between them. Assuming linear friction, the. torque results 
from the brake is proportional ,to the relative axial angular velocity 

i 

between them, that is 


M brake “ K( ®1 " ( 4 “ 1; 

where K is the frictional torque constant which can be adjusted by the 
tightness of the brake. From the Newton's law of action and reaction, 
the frictional brake torques resulted on mass A and.B ate .equal', in mag- 
nitude and opposite in direction as shown in the figure. 

5. FREE-BODY DIAGRAMS 

• I 

For the convenience of setting up the dynamic equations, free 
body diagrams are used.. Figure 4-5 gives the free-body diagrams for the 
satellite, the arm of FFTO, and the body of FFTO. In the figure, all 
forces .and moments acting on each body are indicated. 

Based on the brake model discussed in the last section, the. brake 
torque exerted by the shoulder brake to the arm is given .by 

M^ = K y (4-18 
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where K is a proportional factor and y is the relative -angular .velocity 
between two sides of the shoulder brake. Similarly, the -brake -torque 
exerted by wrist brake to the satellite is given by 


where K s is a proportional factor and y $ is the relative angular velocity 

between two sides of the wrist brake. 

Besides the frictional torque due to the brake there is. inter- 
act! on torque at each brake junction. The interaction torque. is in a 
direction normal to the brake torque. In Figure 4-5, M^, and 

are interacting torque components. 

In addition to the interacting moments effected through the brakes, 
there are interacting forces among bodies at each end or -the arm. At t,he 
shoulder end the interacting force components are (F a , F b ,.F z ), which 
are expressed along the abz coordinates. At the wrist end. the inter- 
acting force components are (F as , F fas , F zs )» which are expressed along 

the a s b s z s coordinates. - ' 

Also control thrust torques T xc , T^ c and T 2C along x,.y,.z axes 
are applied on the FFTO in order to stabilize the whole system during 

the decone-despin process. - 

It should be noted that all inertial forces and moments are not 


shown explicitly in Figure 4-5. 
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6. DYNAMIC EQUATIONS FOR FFTO 

The moment equilibrium equations of FFTO expressed along xyz co- 
ordinates are given by. assuming an axially symmetrical oody. 


A 


hAx + (I 33 ’ ! 22> “y“z 

M y 

It 

I 22“y + (I 11 ", W “z“x 

M z 


! 33“z + ;i 22 " r Tl ' “x“y 


(4-20) 


where I^, I^ and I 33 are the moments of inertia of the FFTO about its 
body axes x, y, and z, respectively. The total external moments M , M 

< . ^ y 

and M z are due to control thrust torques, forces and moments from the 
shoulder brake, which are obtained from moments M , and M 'through 

* M 

the transformation (4-la). 


- % 

r 

M 

s 
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cosy 

siny 

0 
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COSy 0 
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* 
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It 

+ 
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M, 


T 

J 

z 


zc 


(4-21) 


With the help of Figure 4-5, we find 


M a 


’ M a * Vs " 


' M a + Vs' 

M b 

= 

- v 5 


M b - Vs 

M z 


M z 


\ 

• >~ 

J 


(4-22) 
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where moments (M . M, , M ) are the total external moments from. brake 

a D Z y 

end taken with respect to the center of mass, o, of the FFTO.. Successive 
substitution of (4-22) into (4-21) and then into (4-20) gives 


“x + ^33 " 


M'cosy .+ F.frCOSy - M/siny-+.F' -2,-siny + T„ 

u DO D 3 0 XC 

"y + (I 11 - ! 33 >Yx 

= 

M^siny + F^siny + M^cosy - F_£gCOSy + T 
, » , ** 

“z + (I 22 - hlKy 


K i + T z C " 

(4-23) 


The external force exerted on the FFTO is the interaction force 

4 - 

[F a , F^, F^] between FFTO and the arm. This force, when expressed 
along XYZ coordinates, is given by 


V 


p 

F 


a 

F V 

_ T xyz T abz 
XYZ xyz 

F b 

F Z 


F z 

^ J 


(4-24) 


The force equilibrium equation for the mass center of FFTO is tftus 



r •• i 
X, 


f 

F 


f 


a 

M 


T xyz T abz 
‘XYZ ‘xyz 

F b 


z'f 

^ «■ 


/ 

“n 

N 

v 


(4-25) 


v/here M is the mass of the FFTO. 
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7. DYNAMIC EQUATIONS FOR SATELLITE 


In a similar manner, the moment equilibrium equations of the 
satellite expressed along x y z coordinates are given by 


M 

xs 


J 11 "xs + (J 33 " °22 J "ys "zs 

M 

ys 

it 

J 22 "ys + ^11 " J 33^ "zs "xs 

zs 


J 33 "zs + (0 22 ‘ J ll) "xs "ys 


where and are the moments of inertia of the satellite about 

its body axes x s , y and z , respectively. The external moment M , 

xs 

My S » and Ni zs are due to forces and moments from the wrist brake, which 
are obtained from M a$ , M^ $ , and M zs through the transformation (4-2a). 
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Again, with the help of Figure 4-5, we find 


(4-27) 
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M as 



- F bs £ l 
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M bs 
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M bs 
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(4-28) 
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where moments (M as , M^, M 7s ) are the total external moments -taken with 
respect to the center of mass* 0 S , of the satellite. Successive sub- 
stitution of (4-28) into (4-27) and then into (4-26) gives 


J irxs +(J 33' J 22 ,v ys V zs 


M as COSY s" F b$' e i COSY s + h>s s 1 nY s +F as' £ l s ^ ny s'. 

J 22V< J ir J 33>'’zs' , xs 


-M; s Siny s+ F b / I s i ll Y s +M^sCbSY s +F a y i COSY s 

. J 33' , zs + < J 22- J n> v XS v y S . 


-tf. 


(4-29) 

The external force exerted on the satellite is-the-.interaction 
force [F as , F bs , F 2S ] between satellite and the arm. This force, when 
expressed along XYZ coordinates, is given by 
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F Ys 

_ T xyz T abz T a s b s z s 
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The force equilibrium equation for the mass center of satellite is thus’ 
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(4-31) 


where M g is the mass of the satellite. 
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8. DYNAMIC EQUATIONS FOR THE ARM 


Assuming that the mass of the arm is much less as compared to FFTO 
and the satellite so we may consider the arm massless. As a result of 
the masslessness, the total external forces exerted on the arm must equal 
to zero. Referring to Figure 4-6 and resolving all forces along a s> b g , 
and z axes, we get 


or 


or 
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(4-32) 


Similarly, the total external torques acted on a massless body 
must be zero about any point. Choosing point A as the reference point 
as shown in Figure 4-6 and resolving all torques along the a, b, and z 
axes, gives 
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~ S1n9 ~ ^as cose + ^ cos ^ 

" M b " M bs " F a < r cos ^ " F z r simp 
“ M 2 " cose + M' s sine + F b r simp 


= 0 


(4-33) 


In this equation, simp and cosip can be eliminated by using the relation- 
ship 


simp = 


^sine 


COSip = 


where r and L are distances as shown in Figure 4-6, M ' and M' are 
given by (4-18) and (4-19). Then (4-33) becomes 


-Ky + K s ; s cose + m; s Sine + F ^ sine' 
h L ‘ M a ~ M as cose + K 5 r s s]nB 
M b + M bs + F a L + ^l S1 ‘ ne 

9. DYNAMIC EQUATIONS FOR TOTAL SYSTEM 


(4-34) 


The set of vector equations (4-23), (4-25), (4-29), (4-31), (4-32) 
and (4-34) describe the dynamics of the combined Satellite-FFTO system. 
Since each, vector equation represents three equations, there are a total 
of eighteen equations. As mentioned before, the fourteen dynamic vari- 
ables involved in these equations are not all independent; instead, they 
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are subject to the constraint equations (4-11), (4-12), (4-13), (4-14), 
(4-15), and (4-16). 


10. THE CONTROL LAW 

From the analysis of the past sections, applying decone and despin 

brakes, the FFTO will be reacted with forces and moments. which tend to 

make it rotate. In order to achieve the stability of the whole system, 

proper control torques appeared in (4-23) should be applied on the FFTO 

to keep it to the inertial directions as stiffly as possible. 

For this system, the angular velocities u , « and u of the FFTO 

x y z 

are measured by a ser of rate gyros. In order to apply the proper con- 
trol thrust torques, the direction cosine algorithm is selected to study 
the relationship between the inertial coordinate frame and the FFTO body 
coordinate frame. The control law will then be studied. 

Direction Cosine Algorithm - ; 

Let the XYZ axes frame with unit vectors i, j, k be stationary, 
and the xyz axes frame with unit vectors i"' , j', k‘ be the rotating FFTO 
body axes frame. Also let 


OJ 



(4-35) 


be the angular velocity of the xyz frame with respect to the XYZ frame 
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expressed along xyz axes, and C be the "direction cosine matrix" trans-' - 
forming xyz coordinates to XYZ coordinates, i.e., 


H' = £ V' 




where V is any vector expressed in, XYZ- coordinates and V -is the same-- -.5 
vector expressed in ‘'xyz coordinates. C is expressed as 



c il * C 12 C 13 


i • i* 1 • j l ’ i * k' 

/S ^ ~ ~ /V A 

o 

II 

C 21 C 22 C 23 

= 

j • i‘ j • y ‘j • k 

A A A A 


C 31 1 C 32 C 33 


• 

• 

: 

C *r- 

♦ 

1 


h* 


Hence,' the derivatives of elements of C are 

’ i. 1 ’ 1 

. d;* 


, ' r - i 

hi 1 


1= i • “ , k ’V " c 12 u z “ c 13^ 

t J J 

a , i n, . 


C ]2 = i • ^ = i • (k’w x - ■ i> z ) = c i3 t0 x ” C ll“z 


(4-37) 


^13 = * ’ d^ = 1 ’ (1 ’“y “ *\) ~ C ll c0 y ' C 12 w x 
C 21 = 5 • / = J * (j’» z - = c 22“z ' C 23 w y 


df 


C 22 = 3 • d 1 = 3 * ( k ' w x ~ *'-z> = C 23 w x ‘ C 2l t0 z 
dr 1 . 

^23 = J * ' T = j * (i '^ ” = C 2l“y “ C 2 2 “ x n 
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d~ 1 

A * A A. ^ 

k • = k • (j'w 2 - k'ojy) 

d **■ 1 

A ^ ’ A A ✓V 

k ■ ^ = k • { k 1 - i 1 1> 2 ) 


C 32 tJi z ‘ C 33“y 


C 33 w x " C 3l“z 


k • -p- = k • ( i 1 w. 


0'u x ) - C 31 o) y - C 32 (d x 


The derivative of C is therefore 


11 

c 12 

^13 

21 

c 22 

^23 

31 

^32 

^33 

12 w z 

" C 13 w y 

( 

22 w z 

1 

O 

IV) 

CO 

*< e 

l 

32 u z 

" C 33“y 

1 

11 

C 12 

C 13 

'21 

C 22 

C 23 

31 

C 32 

C 33 


C 13 w x “ C ll“z 
C 23“x “ C 21 w z 
C 33 a) x ” C 31 w z 


c ll“y 

c 2l“y 


C 12 u x 

C 22 w x 

C 32 w x 


0 -to 
Q = ui 0 


“z y 
0 -<*>„ 


0 
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be the matrix characterizing the angular, velocity of 
with respect to the XVZ frame. (4-38) becomes 


the FFTO xyz frame 


C = Cfi 


(4-39) 

\ 


Since, in the SateThte-FFTO system, the angular velocities « x » 
a) and w 2 of the FFTO are measured by a set of rate gyros, the onenta 
tion of the FFTO can then be found by (4-39) whose block diagram is 

i 

\ \ . * 

shown in Figure 4-7. , . ; .. . i 


Control Thrust Torques ; 

Control torques are chosen to be proportional to angular displace- 
ments as well as angular rates. They are chosen to be 

' . ■ - 1 < i ' • 


yc 


* . . > i 

l“x + k 2 C ll (C 23 ". C 32 } , 

** » * * ' 4 ' 

>; i 1 4 * 

\ - * 

t 

* 

(4-40) 

\ i 

- • 
t 

f 

‘ 3 “y + k 4 C 22 (C 3l ” C 13 ) ! 

t 

A 

(4-41) 

.s'* 1 


r * 

T zc-“ “ k 5“z + k 6 C 33 (C 12 " c 21 } | 


(4-42) 


The first term in each of these equations is the part proportional to 
angular rate and the second term is the part proportional to angular 
displacement. The second term is obtained through a study of the geomet 
rical relationship between XYZ and xyz. frames. -All k.’s m these 
equations are proportional constants. 






It should be mentioned that, while control law development and 
stabilization techniques are not intended activities of this project, a 
method of stabilization control is needed to maintain the dynamics of ' 
the combined FFTO-satellite system in a reasonable state. Thus the 
chosen control law represented by (4-40), (4-41) and (4^42) is" by no 
means optimal. However, it is effective for: the intended purpose. 

, > s \ 

IT. SIMULATION ' • 

Now there are eighteen dynamic equations represented by (4-23), 
(4-25), (4-29), (4-31), (4-32) and (4-34); there are six constraint 
equations represented by (4-11), (4-12), (4-13), (4-14), (4-15) and 
(4-16); there are three control thrust- equations (4-40) , (4-41) > (4-42); 
and -here are nine direction cosine equations represented .by (4-39). 

All these 35 equations describe the FFTO-Satellite system considered. 

For the convenience of computer simulation, a number of substitutions 
are made among these equations to eliminate some of them. 

t 

Equation Elimination 

Substituting (4-32), (4-14), (4-15), and (4-16) into (4-31), 

gi ves 


M, 


X f " ^sf C 13 
V " l sf ^23 
h ~ *sf C " 33 


t J 


T xyz T abz l T a s b s z s 
! XVZ xyz r abz 
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T xyz T abz 
XYZ xyz 



(4-43) 


Dividing (4-25) by M, dividing (4-43) by M s > taking their difference, 
and rearranging the result with the help of (4-39), 



[r 1 

'"IS 





V 

l sf 

C 23 

C 

L 33 _ 


i + JJ 
[ M M sj 

T xyz 

‘xyz 

jabz ' 

xyz 

/ 2 


By inverting the transformation, gives 


tu 

\ 

MM 

p T xyz t XYZ 

sf abz xyz 

^1 3 

F b 

1 

^23 

\ 

-f- 

rs 

in 

F z_ 


l 

^33 


= D, T X 7 z T* YZ 
1 • abz xyz 


d 

at 


'C 

c 

t 


13 

23 

33 



COSy 

siny 

0 


c n 

C 21 

C 3l 

°1 

-siny 

COSy 

0 


C 12 

C 22 

C 32 


0 

0 

1 


o 

si 

CO 

C 23 

C 33 



5 


(4-44) 


a) C0Sy - Siny + D 


= D- 


*w y Siny 


w x cosy + Dg 
D-, 


where D. s i = 1 to 7, are auxiliary equations as defined below. 

MM 

n = § — p 

U 1 M + M sf 

°2 = Si w y ‘ ^12 w x, 

* j 

■V \ 

°3 = Si “y “ ' Z 22 “x 

l 

°4 = Si “y " S 2 “x 
> 

Dg = D 2 (C-j -j COSy + C 12 Siny) 

T Dg (C^-j cosy + C 22 siny) 

; 

+ (Cg-| cosy + C 32 siny) 



80 


°6 = °2 ( _C n siny + C 12 C0SY ^ 

i 

+ D 3 (-C 21 siny + C 22 cosy) 
+ D 4 \(*-C 3 -j siny + C 32 cosy) 

°7 = °2 C 13 + °3 C 23 +D 4 C 33 


Substituting (4-44) into (4-32), 


F as 


cose 

0 

-sine 


• 

CO 

y 

COSy - 

* 

CO 

x 

siny + 

°B ' 

F bs 

= - 

0 

1 

0 


• 

-0) 

y 

siny - 

“x 

cosy + 

°6 

F zs 

s. * 


sine 

0 

cose 




D 7 


* 


= 'D-, 


uj cose siny - u> cose cosy + Dy sine - 
oj x cosy + <i>y si,ny - Dg 
to sine siny - in sine cosy - Dy cose - 

A O' 


Dg cose 


Dg sine 


(4-45) 


Next, using (4-18), (4-19), (4-44) and (4-45) in (4-34) gives 


M as = “x D 1 £ 1 C0Sy + “y D 1 £ 1 sinY + °13 


j 


(4-46) 


M a " ”"x °9 " “y D 10 + D 11 


(4-47) 


= ~ M bs + “x D 1 L siny " “y D 1 L C0SY " °12 


(4-48) 
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where D^, j = 8 to 12, are defined by the following auxiliary equations 
Dg = cose + /L) D-j 
D g = Dg cosy 

D 10 = °8 sinY 

D 11 = °6 °8 + K s Y s csc0 ~ ^ Y.cote 

D-J2 = L D.| Dg + Z-j Dy sine 

t 

Multiplying the first equation of (4-29) by cosy s and the second one by 
siny s s then taking the difference, 

«. i* 

i 

v xs (J 11 cos ^ s ) ' V- (J 22 ?sinY s ) . - 

i « 

m 

= °13 + h D 1 °6 ~ (J 33 " J 22 } v ys v zs C0$Y s 

* ^ » \ * » 

'l * A* f J 

* (J 11 ■ J 33> v xs "xs s1nY s (4-49) 

where 

°13 = “ D 1 °6 ^1 + ~' K s Y s cos0 )/ si *n® 
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Multiplying the first equation of (4-29) by siny s and the second one by 

cosy , then taking the sum, 

^ ! 

°11 V s ’% + J 22 V “ SY s + lJ 33 • °22> v ys v zs sl >s 

+ (J 11 - J 33> v xs v zs c0 ^s = M bs + F as £ 1 
Substituting the detail of F^ s given by (4-45) into this equation, gives 

i. ’ 

M bs = "“x °1 C0S6 S ^ ny + “y ^"\ D 1 C0S9 C0S Y 

+ \s J 11 si % * v J 22 co % + D 14 (4-5°) 

where 

D 14 ■ (J 33 ' J 22> V v zs s1 >s + (J ]1 " J 33> v xs v zs C0S V 
+ D-] (Dg cose - D -j sine) 

Substituting (4-50) into (4-48), 

M b = "x D 1 5 - “y °16 - "xs J 11 s1n f s - V J 22 C0S Y S - - D )4 (4-51) 

Substituting details of F fl . F b , M‘, given by (4-44), (4-47) and 
(4-51) into the first equation of (4-23), 
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u x (I n + D g cosy + D 1 + D 15 ‘ siny) + (D-, 0 cosy 

- 0 16 siny) - v xs J n siny s siny - 0 ys J 22 COSy s Siny 

4 - ' V 

l , 

\ 

= ~ (I 33 ■ l l£ “y w z + D 11 C0SY + (D 12 + °14 ) sinY 

' * * v ** . 1 

' - V‘ 

+ £g D-j Dg cosy + £g Dg siny + T xc 

where 

D 15 ’ °8 sinT 

> 

°16 = D 8 C0Sy 

Similarly, from the second equation of (4-23), 

I 

f * t 

U x (Dg Siny - D 15 cosy) + ui y (I 2 2 + . D ]0 s1ny + °16 C0SY 

+ l s D^ + v x$ Siny s COSy + v ys J 22 C0Sy s COSy 

> ’ 

= - (I^-j - 1 33) u x + D-j-j siny - (0^2 + ^14^ cos ^ 

i / ' 

» * J 

t < " 

+ l 5 D-j Dg siny - £g D 1 Dg cosy + T yc 


(4-52) 


(4-53) 


From the third equation of (4-23) 
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“z = [K * + T 2 C " (I 22 " “x “y 3/I 33 


\ 

From the third equation of (4-29) 


>zs = C " K s " {J 22 


- J n ) 


V V 1 1 

xs ys J 33 


Differentiating (4-13) 


\ 


c. 


-« x siny + w y cosy - v xs siny s - v ys cosy s 
= («a x cosy + <o y siny) y + ( v>(s COSy s - v ys siny,,)^ 


Summary 

The set of simulation equations is summarized as follows 

j 

' i 

Y s = v 2S - (u x cosy + w y siny) csce 
+ (v xs cosy s - v ys siny s ) cote 
y = -< 0 Z + (w x cosy + co siny) COt6 
-(v xs cosy s - v ys siny s ) csce 


(4-54) 


(4-55) 


(4-56) 


(4-11) 


(4-12) 



fc> z = [K y + T 2C - (I 22 - I n ) ^ My] / 1 


(4-54) 


v zs ' [ " K s y s " ^22 ' J ll^ v xs. v ys^ / J 33 

Grouping (4-49), (4-52), (4-53) and (4-56) into a single mat 

* > ■> 

r 0 

I n + Dg COSY + ^5 D 1 + D 15 Siny D 1Q cosy - D-, g Siny . 

Dg siny - D-jg cosy - I 22 + D i0 S1ny + ^5 D 1 

0 - 0 


l^-siny 


- 

cosy 

-J-j-j siny s 

siny 

-J 22 c0S Y s siny 


" • + 
w 

X 

J n siny s 

COSy 

J 2 2 C0S Y s cosy 


« 

03 

y 

J n cosy s 

' 

J 22 siny s 


V 

-sinys 


-COSf s 

1 

/ys. 


“ (I 33 “ ^22) u y W 2 + ^11 c ® Sy "** ^5 P] ^5 ^Sy 

+ (D 12 + D 14 ) siny + D-j D 5 siny + .T xc 

- ( I j ~ 1 33) ^ m 2 ^11 ^ ^Y -£g 9 -j Dg siny 

- (D-j 2 D-]^) COSy - - 2 .g D-j Dg COSy + "^"yc 

°13 + ^1 D 1 °6 " ^ J 33 " °22^ v ys v zs C0Sy s 
+ ( J ll " °33^ v xs v zs srny s 

(oj x COSy + u y siny) y + (\> xs COSy s - v ys siny $ ) y g 


(4-55) 


'jx equation. 


+ D-j g COSy 
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Among the eight angular variables, y s > and v zs can be ob ~ 

tained by integrating '(4-11 ) , (4-12), (4-54) and (4-55) directly. While 

V V v xs and v ys have t0 be obta1ned by solving the above four Simul “ 
taneous linear equations for &> x » v xs and \> ys and then integrating 

them. A subroutine named "SIMQ" is used in simulation program to solve 

these simultaneous linear equations. ? Also, 

T xc = " k l “x + k 2 C 11 (C 23 ‘ C 32 ) 

T yc = " k 3 “y + k 4 C 22 (C 31 " C 13 5 

T zc = ~ k 5 “z + k 6 C 33 (C 12 “ C 21 ) 


(4-40) 

(4-41) 

(4-42) 


The direction cosine elements C,-'s are obtained by integrating the set 

I J 

of nine equations given by (4-39), that is, 

i 

£ 11 = C 12 “z ' C 13 “y 
^12 = C 13 “x “ C 11 w z 
b 13 “ C 11 “y ‘ C 12 “x 
C21 = C 22 « z - C 23 co y 


C 22 " c 23 w x " C 21 “z 
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8 23 = C 21 “y “ C 22 “x . 

C 31 = C 32 ai z - C33 u> y 

' 8 32 = C 33 “x " C 31 

\ 

8 33 = C 31 “y ‘ C 32 “x 

Simulation Parameters and Initial Conditions 

Values of parameters and initial conditions used for the simula- 
tion are shown below. 

Parameter Values (Figure 4-8) 

FFTO: 

M = 200 kg 

1 

J 

^1 = if (0 ' s2 + T - 5 *) = 48 * 17 kg “ m2 

! 22 = jf 0»2 2 + 1.5 2 ) = 61.5 kg-m 2 

1 33 = (0.8 2 + 1.2 2 ) = 34.67 kg-m 2 

hi = *23 = *31 = 0 

h = ^r = °- 75 m 
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Satellite: 

M c = 6,600 kg 

R '= 1.741 m, 

) 

h = 6 R = 10.446 m 
£ ] = 0.5 h = 5.223 m 

0 33 = 1 MR 2 = 10,000 kg-m 2 

J n = J 2 2 = if {3r2 + h2) = 65 ’ 016 ‘ 7 kg_m2 

J 12 = J 23 = J 31 = ° 

Arm of FFTO: 

Assume Massless 
= 1.277 m 

£3 = 5.0 m 

£ 4 = 0.5 m 

Initial Conditions 


a l = a 2 ~ 6 ~ ^0° 
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to 


xo 


- to. 


yo 


to 


zo 


= 0 


v = -0.3464 rad/sec 
xso 


v 

yso 


= 0 


\> = 1.300334 rad/sec. 

zso 


y = 0 

Ys = Q 

C n = C 22 C 33 = 1 

C 12 = C 21 = C 23 = C 32 = C 13 “ C 31 


The initial condition data shows that 


H 

H 


zs 

as 


J 33 v zs 
J 11 v as 


10,000 x 1.3003 
65,016.7 x 0.3464 


~ = cot 60° 
✓3 


Hence, H_ is initially along the z-direction as shown in Figure 4-9. 


Brake Forces . The brake force factors are chosen to be ramp 
functions are shown below. 


K = K s = 1000 t 


(t in seconds) 
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Thrust Torques 

k 1 = k 3 = k 5 = 10,000 

k 2 = k 4 = k 6 = 100,000 

Simulation Results and Discussion 

Results of the simulation are plotted in Figures 4-10 to 4-16. 

The simulation revealed a stable joint dynamics of the FFTO-satellite 

system. The results are very encouraging. 

Figure 4-10 shows the time responses of FFTO's reaction angular 
rates. The reaction angular rates decrease as expected. The oscilla- 
tion in each angular rate, though may not be objectionable, can be re- 
moved by adopting a different control law or by increasing the. rate - 
control constant k. (1=1, 3, 5) of the present control law. 

Figure 4-11 depicts the time response of direction cosines C.., 
i = 1 to 3, of the FFT0. Their values are not constant, but the varia- 
tions are small. The maximum deviation of .the values of direction 
cosines from unity is 0.014. This deviation practically disappears com- 
pletely after 15 seconds, indicating an effective stabilization effort. 

Figure 4-12 contains time responses of the satellite's angular 
rate during the detumble-despin operation. It is shown that, after 15 
seconds, the satellite lost most of its dynamics from an initial rate 
of 1.3 rad. /sec to less than 0.1 rad. /sec along the z s ~axis. .Similar 
behavior is for other axes. 



(rad/sec) 







(rad/sec) 



VO 

cn 
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Figure 4-13 plots the angular momentum of the satellite. The 

4 

momentum is reduced in 15 seconds from its initial value of 2.6 x 10 

kg-m 2 -rad./sec to 2.8 x 10 2 kg-m 2 -rad./sec which is about 1 % of the 

) 

initial value. 

Figure 4-14 shows the relative angular rates at two brake junc- 
tions. The angular rate y g decreases nonotomically while y decreases 

with a small oscillation at the beginning. 

Figure 4-15 shows the relative angles at two brake junctions. 

Both angles become constant after about 15 seconds indicating the 
diminishing of relative motion between the FFTO and satellite. 

Figure 4-16 gives the time responses of thrust torques in three 

.4 

orthogonal directions. The maximum torque value is about 2,6 x 10 

3 

newton-meters in the x any y directions and about 2.2 x 10 newton- 
meters in z-di recti on. The oscillations in torques require oscillation 
in thrusts which may be objectionable. However, by using a different 
control law the oscillatory behavior can be removed. 

Simulation Program 

The simulation is written in CSMP which is included in Appendix 2. 







Thrust Torques T . 7 , T (X10 4 nt-m) 




CHAPTER 5 

SUMMARY AND RECOMMENDATIONS 

This study resulted in three kinds of equations of motion for the 
free-flying teleoperator system. The first kind is a set of kinematic 
equations for the FFTO's manipulator. They describe the positions.and 
velocities of the manipulator hand with, respect to various coordinate 
systems. These equations are useful in generating the reference signals 
for the control of the position and velocity of the hand, especially for 
catching an object which is within the reach of the arm. 

The second kind of equations of motion are two sets of equations 
which describe the dynamics of a satellite under an ideal detumble and/or 
despin operation. The idealized assumption is that the FFTO is fixed in 
space. The objective of this study is to obtain some understanding 
about the satellite dynamics, paving a way for the study of more realis- 
tic cases later. The first set of equations is for the case where the 
body of a satellite is axially symmetrical. Computer simulations were 
obtained for this case. The second set of equations is for a general 
body configuration. The analytic expression for this case is very 
complex. No simulation was performed. for this case. 

The third kind of equations of motion is a model describing the 
combined dynamics of a FFTO and a satellite during detumble and despin 
operation. The FFTO is not assumed fixed. The motion of FFTO is due 
to the reaction torque and force exerted by a dynamic satellite. The 
set of equations are highly nonlinear. For the convenience of 
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observation, the joint dynamic of the FFTO-satell ite system is quieted 
down by the use of a FFTO stabilization. A direction cosine control law 
is arbitrarily selected for this purpose. Simulation was performed to 
test the model. The result confirms the adequacy of the model. 

All the computer simulations were written in CSMP. They are- 
ihcluded in the appendices. The parameters in these programs -can be,. 

changed to simulate different conditions.' 

The development of the above models has allowed us to gain a deep 
understanding of the motion of a FFTO, a satellite, and their combina- 
tion. Momentum and competence now exist enabling further research to • 
the problem. The following areas are recommended for further study. 

Thrust Level Reouirement . To obtain a good stabilization of the 
joint FFTO-satell ite system the thrust level was not limited in the sim- 
ulation. The maximum thrust value was about 2.5 x 10 4 newton-meters ^ _ 
along x or y axis, and about 2.2 x 10 3 newto'n-meters along z-axis. 

These values seem large. It is important to find out if the detumble- 
' despin operation can be accomplished using a more realistic thrust 

level. 

Effect of 'Arm Mass . In the present study, the arm mass has been , 
neglected. Inclusion of arm mass will complicate the analytic formula- 
tion a good deal. However, knowledge of effects of arm mass on the 
total system dynamics and on the control effort is important. A study 
of these effects should be made. 


t 
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Variable Arm Angles . Arm angles a-j and a 2 were made constant for 
the present study. It is not known yet if there is any advantage -to be 
gained by allowing and « 2 to vary. Permitting variable a-j and a 2 
will also increase the complexity of the equations of motion. But based 
on the results obtained in the present study, this generalization can be 
made without too much difficulty. 

Desired Control Law . The control law governs brake forces and 
thrust levels. The control law used in this study is arbitrarily chosen. 
A study should be made to arrive at a simple but effective control. Due 
to the nonlinearity and the high dimensionality of the system, this task 
is not a simple one, although the results of the present study will make 
it easier. One important consideration is the advantage of exerting a 
preferred combination of despin and decone torques to maintain the 
angular momentum vector of the satellite as stationary as possible in 
space. It is believed that this will help in reducing the need of high 
stabilization torques for FFTO. The result obtained in Chapter 3 can 
help to accomplish this. 

Motiona l Simulations . Due to the limitation in time many de- 
sired simulations could not be performed. With the model already 
developed, it will be very worthwhile to continue the desired simula- 


tions. 
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APPENDIX 1 


CSMP PROGRAMS FOR CHAPTER 3 


A. Simultaneous Despin and Decone 


LABEL DcSPIiNIKG AND DECOKING KITH A=300 


INITIAL 
CONSTANT 
DYNAM IC 
parameter 
C= A*T ETI 


i 

lAl=9529,ITL=212l29 t PHII0=0tSYC=0 f T r T 100=0 f M0 = 0 
TET10=1. I486 t PHI 1C0=4 .19,$YD0 = 0 .48C9 , A=8G0 


MX= 0 

MY=-C*SYD*SIN(TETI) 

MZ=-C*IAl*(SYC*COStTcTl) tPHTlDJ/ITl • 

TET 1U2 = { MX- 1 A1Y ( PHI iD + SYD*C r S ( TET U )«SYD^ S IN ( TET1 ) ) / I T 1 + S YD** 2* . o „ 


5l.'»iT£TLJ*C-JS(TETl) - 

SYG2 = {MY~2*1 T 1*SYD*TET.ID*CCS ( T ET 1 ) + I AL* ( D P I ID«-SYD*CCS ( T PT 1 ) ) - . . « 

TET ID ) / ( ITl^SIMTETl > ) 

PHIID2 = MZ/ {AL-SYO?<-CCS(TETl) + SYr*TeTin*SIN( T ETI) 

it = S0KT(I Tl**2*{TET lD**2-t-SYC* *2>rS 1 M T T 1 ) * *? I + I A 1**2* { PH 1 1 D+ . . . 

SYD-CUS(TETL) ) ^ ^ 2 ) „ , , ^ , 

ANGL=SQKT{(iTI*7ETin)**2+{SYD*SIN (TFTlI^CnSlTFTlI^IITl-TAU-IAL^o.* 
PHI ID ) **2 i/(IAlv(PHIlD+SYD^C p S(TETl))’!'C^S(TETl)+ITl^SYO>i : SIN(TETn*^2) 


OETA=ATAiM(ANGL) 

Kl2 = SQRT (TET IC**2 + SYD**2*SIMTET1 )#*2 ) 
WP=PH ILD+SYD*CGS(TET1) 
M=SQRT(MX**2«-MY**2 + MZ**2 ) , 

SYD = INTGt\L(SYDC,SYD2) 
SY=1NTGRLUY0,SYD) 

PHI 1D = INTGRL ( PHI 1 DO, PH I ID2 ) 

PHI 1= IMTGRUPHI 10, PH i ID ) 
TbTlU=INTGRL{TLTlC0,TETlD2 ) 



T£T 1=INTGRL(TET10«TETID) 

MT = 1 N TGR L ( MO » K ) 

PRINT MT 

PRTPLT SYO,PHUD,TETl f H,BETA, hl2,h3 
TIMER D£LT=0<,C5,FIKTlf'=60 0,f 1 UTCEL=5 
FINISH oYD=O.Cl 

PRTPLT SYU f PHI 1D ? TETL» H, BETA ,h 12, W3 
END 

TERMINAL 

siup 

END JOB 


B. DETUMBLE THEN DESPIN 


LABEL DcTUMBLING THEN UE SPIKING WITH A=PD 
INITIAL 

CONSTANT IAi=9529,ITl=2i2129,PHIlC=0 T SY0=0,TFTlC0=0 ’ 

DYNAMIC ? u 

PARAMETER T cT 10 = 1 . 1486 , PH 1 1 C0=4 , 19 , SYD0=0 . 480 9 , A = 20 . . . . 

x= ~ i» Y=-l t Z=0»M=0. OLt N= 10 , MC = 0 

6 = ANO( A, TL-TI j 

C=B*A*TET1 

MX = C*X J i e TET ID 

MY=C*Y*SYU*$ I MTET1 ) 

MZ=C*Z 

Saln“cist^ni UD4S¥D ’ fc ' :SITFTU) * SYD * slN,TEn,,/IT1+SYD « 2< '"* 

TEIlu'/l ITl^S INI TETl)) l0a,CCS <TF11 1 + 1 4141 PH! ID+SV0 * CCS ( TET1 1 **• • • 

PHI ID2=MZ/IAI-SYD2*C0S( T E T 1 } + $ YD*7 E T1 D*S I NJTETI > 

«ur l r^ QKT< (1T1 ’ j<TETiD, * 5:t2+(SVD!! ‘ SIW(TET n«COS{TFTl)>!'{ ITl-IAU -IA1* 

PH 1 10 ) *'#2 J / ( I AI *(PHI1D+SYC*C0S(TET1 ) )#CQ$(TFT1)+IT1*$YD*SIN(TET1)#*2 


o 

CO 



BfcTA=ATAN( ANGL) 

W12=SQRT (TET1C**2 + SYD**2*S JMTETi >**2) 
rt3=PHll.Q«-SYD*CCS(TETl ) 

«»S«RT (tf X**2*-MY#*2+MZ*-*2) 
SY0=INTGRL(5YC0»SYD2 ) 
SY=INTGRL(SYO ? SYD) 

PHI1D=INTGRL ( PH 1 1 DOt PH 1 1D2 ) 
PHll=lNTGKLtPHUO,PHIiD> 

TETLO = lNTGRLnETLDOtTETLD2 ) 

TE n» iNTGKLtTE TLO, TfcTID) 

MT = INTi»kL(MO» m 

PRTPLT SYl>,PHI1D,TET1,H,BETA,W12,W3 
PRINT MT 

TIMER DtLT=0. C5 ,FINTIM=50C0 ,CUTDEL=25 

FINISH W1Z=U t. 2CO 

END 

TERMINAL 

STOP 

ENOJOB 


LABEL DE TUMBLING THFN OESPIMNG h I T H A = 200 

initial 

CONSTANT I Al=9529, ITI=212129»PHI10=C,SY0=0»TET1C0=0 
DYNAMIC 

PAkAMlT ER TtT10 = l . 1 486 , PH I ICO = A . 1 9, S YD0 = O . 4 8 C 9 , A = 200 , . . • 

X=-l» Y=-liZ=0,P=0.01,N=10,MC=0 
6-AND ( A , TET I ) 

C=B*A*T£TL 

MX=C*X*TtTlD 

MY=C*Y*SYD*$IN(TETl) 

MZ=C*Z 

TET ID2= { MX-I A1*(PHUD + SY0*CCS(TET1) ) *SYO* S I N ( TET 1 ) ) /I T 14-SYD**2*. <• . 

SIN(T tTl )*C0S{TET1 I * 

* SYD2= IMY-2*IT1*SYO*TET1D*COS (TETD + I Al*( PHI 1D + S YO *CC S ( TET I ) > * . . . o 



TfcUO i/{ IT L#S INI TET1 ) ) 

PHUD2«MZ/IA1-SYD2*COS(TET1)4SYO*TET1D*SIMTFT1> 

H = SUKTlITl J ‘ 5 *2 : i < (TETID* i '' c 2-4-SYD**2 , ! t SIMTETl)^*2)-i-IAl >:< *2*lPHII0 + o.o 


SYJ*C 0 S(TtTlU** 2 ) 

AiMGL=SQKT {(IT1*TET10)**2*{SYD*SIN(T£T1)*C0S<TET1)*IIT1~IM)-IA1 *oo,> 
PHI10)**2J/nAl 3 MPHIlD + SYC 5 i‘C0S{TETl))*CCS{ T ETn*ITl'') ! SYD*SlNlTETl)#* < 2) 


BfcT A= AT AN ( ANGL ) 

w!12 =StjK r(TcTlC* t5} '2 + SYD*#2 J l'SIMTETl) >! ‘ , i‘2 ) 

W3=PHIH)+SYU*C0$<TETU 

M=SQRT (MX>*’< < 2-H' / Y**2+MZ : <' , i : 2 ) 

SYD=INTGRL(SYDC?SYD2) 

SY=l(\lTGRL!SYO»SYO) 

PHI IL) = INTbRL ( PH 1 1 DO 7 PH 1102 ) 

PHI i~ iHTGKL ( PHI 10, PHI ID ) 
r£UD«lNTGRL ITI:T1D0,TET1C2 ) 
TET1=INTGRL(T£T10»TET1D) 

MT=INTGRL l MO, Mi 

PRTPLT SYD,PHI10,TET1,H,BETJS,U12,W3 
PRINT MT 

TIMER DELt=0 *05 ,FINTIM=80C ,CUTCEL = 5 
FINISH W12=0.2C0 


END 

TERMINAL 

STOP 

ENDJOB 


LABEL DETUMBLING THEN DESFIMNG WITH A = 800 
INITIAL 1 

CONSTANT I A 1 = 9 529, IT 1 = 2 12 129, PHI 1C=0, SY0=0 ,TET 100=0 
DYNAMIC ' ’ ‘ 

PARAMETER TE T 10= 1 . 1486 , PH 1 100 = A . 19 , SYC0 = 0 . 4809 , A = 800 , . „ „ 
X=-i, Y=-1,Z=0,M=0.01,N=10,RO=0 
B=ANO(A,TETi ) ‘ ’ 

C=a*AvTcTl 



MX=C*X#Tt£TLD 

MY=C*Y*SYU*SIN(TETL) 

MZ=C*Z 

TET 102= ( MX-I AI*(PHI1D+$YD»CGS(TET1) ) *SYD * S IN { TET1 ) ) /I Tl+S YD*#2*. » * 
S1N(7ET1)^CJS(TET1) 

SYD2=lMY-2*m*SYD*T£TlO*CCS(TETl) + lAl*{PHllD*SYD*CnS(TETl ))*, .. 

TE T ID ) / ( IT1*SIM TETI ) ) 

PHI WZ- MZ/ 1 A 1 -SYD2*CQS( TET L ) + S Y0*T 17 T 1 P* S T M TET1) 

H=*CjRrurjL* + 2*(TETlD**2 + SYD**2*SIN( TET 1 ) # *2 > + 1 A 1**2* ( PHIID + . • • 
SYD*CUS{ TETi »)**2 i 

ANGL=SQAf ( ( IT L*T ET LD 1 **2-* { S YD*S IN ( T P T 1 } *C OS ( T E T 1 ) * 1 1 T 1- 1 A L ) - 1 A l* . . . 
PHI ID )**2) / (I AL*(PHlin+SYC*COS{TETl n#CCS (TETI ) *IT 1*SYD#SIN(TETU**2) 
BtTA«ATAMANGL ) 

rtl2=SDKT (1 ETiC**2 4-SYD**2*S IN { TET 1 )**2) 
rfJ*PHllO+oYO*CCS(TETl) 

M= SORT (MX#*2+MY*#2+MZ**2 ) 
i>YU = IlNjTbRL(jYD0?SYD2) 

S Y ~ iNTGAL ( $Y0 f SYD ) 

. PHUl>=INTGRU PHI1D0, PHI1D2 ) 

PHU = iNTGKL ( Phi 10 r PHI ID) 

T £ T I D = I N T GR L ( TET1U0, TET1D2 ) 

TETl=ifMTGKL( TCT10, T£TW) 

MT= INTGKL ( MO » Y ) 

PRTPL T SYQ,PHIlD t TETl ,H, BETA, WL2, W3 
, PAINT MT 

TIMER DELT=0.05,FINTIM=80C,CUTDEL=5 
FINISH wL2=M,W3=N 
CUNT INUE 

TIMER DtLT = 0«05»FINTIf J '=70C*CUTDEL=5 

PARAMETER TETI 0 = 1 . 1486 , PHI 100 =4 . 19 , S YDO =0 *A80S » A=800 » . . . 

X=D t Y=0, 2—1 r M*I0»N»0»01 
END 

TERMINAL 
STOP 
END JOB 



LABEL DETUMBLING THEN DESPINING kJTH A-1600 

CUNSTANT 1 Al= < 5 52 < 9 » I T 1=2 12 129 . PHI 10 = 0, $ YQ= 0 ? T£ T L 00 =0 
DYNAM IC 

PARAMETER TfcT10 = UL486,PHllCO = 4.19»SYDO = 0 .4809 , A= 1600 * *. • 

X=-LfY = -L»Z=0«M=0<>Gl»N=iO?PC=0 
8= AND { A » T b Ti ) 

C=b*A*T ET1 
MX=C*X*rfcTl.D ' 

MY=G#Y J PiYL)*SIMTET L ) 

tetidLimx-i ai*<phud+$yo*cos<teti> >*syd*sini tftd )/iti+syd**2*». 

SY02= IMY-2*IT i*SYD*TET ID*CC $ ( TET 1 )+I A1*<PHI 10*SYD*COS{ TET1 ) )*• •• 

TElLD)/( m*SlMT£Tl> ) t 

Pril lD 2=MA/ IA 1-SYD2*C0S( TET 1 ) + SYD’!'TE T iD*SIMT p TL) 

H«bQRT (IT1**2 1 MTET ID*-* 2 + $Y 0**2*$ IN ( Tb T 1 }**2 ) + I A l** 2* ( PHI 1 D+» * ° 

ANGL=b>UKl ( t IT l^T ET ID) * >J: 2+ < S YD’i'SI N (Tf-T 1)*C0 SI TE T 1) ❖ 1 1 T l-I Al ) -I Al^o « o 

PHI j.D)**2i/ I IAl*t PHILD+SYC*CQ5(TET1) ) *COS ( TET1 ) * IT 1*SYD*SIN(TET1 ) * 2 ) 
dfcTA=ATANUNGL> 

Wl2 = SgkT(TET LC*-*2*SYD**2*S IN ( TfcT 1 ) **2 ) 

W3=PHI1U+SYUVCCSCTETL) 

M=iDKT (MX»*2+>'Y**2 + MZ#*2 ) 

SYD«INH5RL(SYD0tSYD2) 

SY=INTO*L(SYO,SYO) 

PHllD=lt\!TbRL (PHllDOtPHl 1D2 ) 

PHli=INT(sRL{PHI10»PHllD) , 

TET1D=INTGRL< TCT 1 00 i T E T LC 2 ) 

TET1=INTGRLITET10,TET1D) 

MT- I NTGKL ( MO j M ) 

PRTPLT SYD»PHIID»TETl»H f BETA»Vil2,Vi3 
PRINT MT 

TIMER' DELT=0.05,FINTIM=60C,CUTDEl=0o5 
FINISH WL2=0. 200 




END 

TERMINAL 
STOP 
END JOB 


lNinAL £TUMbLING THEW 0ESPlNIN « WITH A=3DOO 
D«A lie' IA1=,5i<5 ’ I T 1 = 212129,P(JUC.0,SV0»0,TET1D0=C 

I" -^S!r.l1J^™!io.T' 1 ' ;,£yoo=0 - 4ec, ’ A -' 330 o-"- 

U=ANU£A, TETIJ 
C=b*A*TfcT I 
MX=C* X^TETJ. D 
MY=C* Y*SYO*SIMTET 1 ) 

Iim?ea“wsaE?n l0+ ? VD * cc ' s ,TE7n ,t; srD ’* s !N! TtT1 ' >/itusyo*.2»..' 

rtriD)/UT*i$m[?ETuI lDtC!:5(TFri, * U1 '" (PHI1D '' SVD,c "S!TETi)l»... 

bydvcos ( rern )** 2 ) A SIN(Tfc ' i)'-*2i + iAi**2*(PHn l o+... 

Bt TA = ATAN [ ANGL } ‘ ( ThT l ) + IT I^SYD^S I N ( T E T 1 ) 4 

WJ-PHi lO-s-SYD'fCOS C TET 1 ) 

M=SDRT (MXv^2+-MY#^2+M2**2 ) 

SYD=I NTGKLI SYGC » S YD2 ) 

SY=INTGRL ( o yo t SYD ) 

PHI 10 = INTGRl { P hil D0 f PH 1 102 ) 

PHII= iNTGRL ( PHI 10 » PHI ID > 


Oj 



TbTlD = INTGRL(TETlC0»TETJLD2 ) 

TbTi= INTGKLITET10, TETID) 

MT=INTGRL (M0» M ) 

PRTPLT SYD,PHUD»TET1 »H , BETA , »«12 , W3 
PRINT MT 

TIMER DElT = 0<,C5pFINTIM=60G»CU7DEL = 5 

FINISH Wl2=0e 200 

END 

TERMINAL 
STOP 
END JOB 


C. DESPIN THEN DETUMBLE 


LABEL DeSPINING THEN DECCMNG V> I TF A=800 
INITIAL 

CONST ANT 1 AL=S529, IT1=2 1 2 1 29 , PHI I 0 = 0 t SY0 = 0 , TF T IDO =0 
DYNAMIC 

PARAMETER TET 10 = l « I486 T PH 1 1 CO =4 . 19 1 S YDO=Q . ^80 9 t A= 600 , . 

X=0»Y=0» £=-l »P=10,N = 0.01,PO = 0 
8= AND { A j TcTl I 
C = B<'A*TET 1 
MX=C*X*Tcl ID 
MY^W^SYD^S IN (TET1 ) 

MZ=C*Z 

TET LD2= ( MX-I Al*{ PHI1D *SYD*COS (TET I ) )*SYD*S IN ( TET I )) /I TI + SY0**2* 
SIN ( TET 1 J#C0S(TET1) 1 

SYD2=(MY-2*IT1*$YD*TET10*C0S{TET1 H-IA1*{PHI ID* S YD ❖CO S ( TET 1) ) * „ „ 
TETID)/ l IT l#S IN (TET1 } ) 

PHILD2=MZ/IA1-SYD2*C0S( TET 1 ) +$YD*TETID*SI N (TET1 ) 

H=SQRT { ITl**2*(TET10**2+$YD**2*SIN{ TET1 )**2) + I A 1**2* ( PHI ID*. . . 
SYD*CGi(TtTI) )**2 ) 



_c,mT{ f ITI^TFT 10)* s « i 2'M5YD*SIN<TETl)*COS(TETl)*t IT1-I AL) - I A !■*••• 
WuS!2«!/{«IUJJi?lD4YD.cSslTrT l )..e05<TBTl»*ITl*SY0.SIN(TETn..al 
BE Fa=ATAM ANGL) 

W12=SQRT {TeTlC **2 + SYD**2*SIMTET 1 )**2 > 


W3 = PHi 10-s-SYD*CCS{ TETL ) 

H=SQRT {MX^Z + MY’evZ + P/.* 5 ^ ) 
SYD = INTbKL( SYCO ? SYD2 ) 
$Y=INTGkL(£>YO,SYD) 

PH no *lNTt.RL( PHI IRC, PH 1 102 ) 
PH1L= INlGRL(PHI!0»PHiIU » 

TETlU = irjroRL(TETlC0 ? TETlD2) 

Till- I NT GRL (T ET1 0 ? TETLO) 


MT = I NTORL { MO » P ) 

PRTPLT SYD»PHIlD ? TETl»HtBETA,Wl2»Vi3 

PRINT MT 

TIMER DlLT = GoC 5»FINT1P=L5C»CL'TOEL=5 
FINISH W12=M » R3=N 
CONTINUn ' 

TIMER 0cLT*u.05,FINTIM=6CCtOUTDEL*5 

PA RAM El ER TETL0 = l.I486,PHIlC0 = A.I9,SYC0=0o48C < 5,A-B00 


X=-x T Y=-l»Z=0ff / = 0.Cl»N=10 

PRTPLT SYD»PHIlU t TETl,H,BETAtV>12tW3 


* ♦ o 


end 

terminal 

STUP 

ENDJOB 



APPENDIX 2 


CSMP PROGRAM FOR CHAPTER 4 


TITLE CSMP SIMULATION OF THE SATFLL ITE-FFTO SYSTEM 
INITIAL 

DI-M*MS*LSF/(M+MS) 

CONSTANT Kl= lOOOO. , K2 = 100000 • , K3= 1 0000 . , K4 = l 00000 . , . .. 
K5= 10000. ,K6 = 1 00000. , L 1=5 . 223 , L 5=0. 75 , LS-F=7.0,.. . 
L=3. 6385, I 11=48. 17, 122=61. 5, 133=34. 67, ... 
J11=65016.7,J22=65016.7, J33=10000.0,M= 200.0, ... 

MS = 66 00.0. SIM0=0.866,C0S0 = 0.5 
DYNAMIC 

K= 1000. 0* RAMP { 0.0 ) 

KS= 1000 . 0*R AMP (0.0) 

WX=INTGRL(O.Ot WXDOT ) 

WY=INTSRL10.0, WYDOTJ 
WZ= INTGRL! 0.0, WZOOT } 

VX S= I NTGRL I -0. 3464 » VXSOOT ) 

VYS=INTCRUO.O,VYSOOT) 

VZS=INTGRL ( l .300334, VZSDQT ) 

Cll= INTGRL<1.0,C1100Ti 
C12= INTGRL ( 0.0, C 120GT } 

Cl 3= INTGRL (0.0,C13DGT } 

C21=INTGRL(0.0,C2100T) 

C2 2= INTGRL! 1.0, C2200T) 

C23=INTGRL(0.0,C23D0T ) 

C3l=INTGRL(0.0,C3L03T) 

C32= INTGRL { 0 .0 » C32D0T } 

C33= I NTGRL ( 1.0, C33D0T ) 

RS=IMTGRL (O.OtRSOOT) 

R= I NT6RL (0.0, ROOT ] 

C11D0T=C12*WZ-C13*WY 

C12D0T=C13*WX-C11*WZ 

Cl 3 DOT = C 1 1* WY-C 12*WX 

C2 1DQT=C22 S >' S WZ-C23*WY 

C22D3T=C23*WX-C21*WZ 

C23D0T=C21*WY-C22*WX 

C31D0T=C32*WZ-C33*WY 

C32DQT =C33*WX-C31#WZ 

C33DOT=C31*WY-C32=WX 

SINR,C3SR,SINRS,COSRS=SINCOSIP ,RS) 

TXC=-Kl*WX-f-K2*Cll*!C?3-C3 2) 

TYC=-K3*WY+K4*C22* (C31-C13 ) 
TZC=-K5*WZ+K6*C33*!C12-C21 > 

H= SOR T ( ! JU = VXS) **2-M J22*VYS)**2 + { J33*VZS )**2} 
WZD0T=(K#RD0T+T7C- (122-111 |*WX*WY) /I 33 
VZSD0T=-kS*RS00T/J33 

RDGT=-WZ+( WX*COSP+WY*SINR)*COSO/5INO-( VXS*COSRS-.. . 
VY S*S INRSI/SINO 

RSDOT=VZS-(rfX*C0$R+WY*SINR)/SINO+tVXS*COSR$-.. . 
VYS*SINRSi*CQSO/SINC 
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D2=C11D0T=*WY-C1200T*WX 

D3=C2LDQT=*cWY-C22DOT*WX 

ha- r 3 100T *WY— C 3 2DOT ,s VJX v _ 

05 = <Cll*C0SR+C12*SINR)*D2+t C21*C0SR+C2 2*SINR)*D3.. 

+(C31*COSP+C32*SINR>*D4 

D6=(- C1 l*SINR+C12*C0SRJ*D2+(-C21*SINP+C22*C0SR)*.. 
03+ { ~C3 l*COS R*-C32*COSR ) *04 

D 7 - C 1 3 * D 2 + C 2 3 * D 3 + C 3 3 * 0 4 
08=01*1 L+Ll*CO$C)' 


D9=D8*CQSR 
n i 0=D8*S INR 

01 1 = 06-08 +K$*RSDOT/S IN3-K*RDGT*CGS0/S I NO 
m ?=L*0 1*D5+L 1*01*07*5 IMG 

Q13 = -L1*D1*06-M K*P DGT-K S*R SCOT * COSO } /S ING 

D14=(J33-J22)*VYS*VZS*SINRS+(J11“J33)*VXS*VZS*... 

C0SRS+LI*DL*(D5*C3SG-D7*SINC) 

015 = 08* S INR 

Bl = - ( 133- I 22 ) *W Y* W Z +D 1 1 *C Q S P +L 5* 01 *06* CO SR • *■ 

( 012+014 )*S INR+D1*L5*D5*S INR+TXC 
B2=-( I 11-1331*W**WZ+0LL*SINR+L5*DL*D6*SINR-. . • 

(D12+D14)*C0$R-D1*L5*05*C0SR+TYC 
B3=0L3+Ll*Dl*06-( J33-J22 )*VYS*VZS*COSRS+< JU-. . - 
J 33 ) *VXS* VZS* S I NRS 

B4=VXS*C0SRS*RSD0T-VYS*SINRS*RS00T+WX*C0SR*R00T. • 

+ WY*SINR*RDOT 

Ai i=I ll+D9*C0SR-*-Di*L5-»-015*SINR 
A12=D10*CQSR-D16*S INR 
A 1 3=-J 1 1*S I MRS* SI NR / 

A14=-J22*C0SP$*SINR 
A2 l=D9*SINR-D15*COSR 
A 22 = I 22+0 1*L5+D1Q*SI NR+D16*CQSR 
A23=J11*SINRS*CCSR 
A24=J22*C0SRS*C0SR 
A33=J11*C0SRS 
A34=-J2 2*S I MRS 
A41=-S I NR 
A42=C0SP 
A43=-S I NRS 
A44=-C0 SRS 


WXD3T, WYDOTt VXSDOT 


,VYSDQT=SUBXYZ{B1,B2*B3,B4» . 

All , A12.A13. A14» A21, A22,A2 3» A24.A33 »A34, .. 
A41 , A 42, A43, A 44 ) 

TIMER FINTIM= 100 ,0»0UTDtL = 0 . 3 _ _____ onrr 

PPTPLT WX,WY,WZ,VXS, VY$,VZS ,C11,C22,C33» RSDOT, ROOT, 
RS,R ,TXC,TYC»TZC,H 

LABEL CSMP SIMULATION OF THE S AT ELL IT E-FFTO SYSTEM 


END 

STOP 
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C THIS SUBROUTINE IS USED TO CHANGE THE ARGUMENT TO BE 
C LESS THAN 18*2*8 I BEFORE CALL *$IN« AND «CO$ 5 
C { ARGUMENT OF LIBRARY SUBROUTINES «SIN S AND ’COS' IS 
C LIMITED TO 18*2*PI) 

C 

SUBROUT INF S INCOS { R, RS , S I NP , COS R »S INRS , COSRS ) 
REAL LIMIT 

L IMIT=2 .0*18 o0*3. 141592653 
I R=R/LI MIT 
AR=R- 1 R*L I MI T 
S I NR = S I N ( AR ) 

COSR=COS ( AR) 

I RS=RS/LI MIT 
ARS=RS-IRS*L IM IT 
SINRS = SIN t ARS) 

COSRS=COSIARS} 

RETURN 

END 


C THIS FORTRAN SUBROUTINE IS USED TO CHANGE THE 
C UN SUBSCRIPTED ARRAY INTO SUBSCRIPTED ONE BEFORE 
C CALL SUBROUTINE »SIMQ # (SUBSCRIPTED ARRAY IS NOT 
C PERMITTED IN CSMP) 

C 

SUBROUTINE S UBXYZ £ B 1 . B2» B 3 » B 4, A i 1,A12.A13,AL4,A21» 

C A2 2, A2 3 t A24»A33» A34, A41 » A42* A 43 , A44, WXDQT , U YDOT , 

C VXSDQT 9 VYSD0T> i 

DIMENSION A 14, 4) ,B(4) 

N=4 

A { 1» 1 J =A 1 1 
A { 1 9 2 ) =A 12 
A ( 1 ? 3 > =A13 
A ( 1,4 )=A14 
A ( 2 , 1 )=A21 ' 

A ( 2 , 2 ) =A22 
A (2, 3 ) =A 23 
A ( 2» 4 ) =A24 
A { 3 , I ) =0. 0 
A ( 3, 2 ) = 0 .0 
A { 3 9 3 ) =A33 
A ( 3,4) =A 34 
A ( 4, 1)=A41 
A<4.2 )=A42 
A ( 4 » 3 ) =A43 
A ( 4 9 4 ) = A44 
B { 1 ) =B1 . 

B (2) = B2 
B ( 3 ) = B3 
B (4) = B4 

CALL S I MO (A,B,N,KS) 



or>o ooo ooo o o o 
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W X DOT = B ( 1 5 
WYD9T = B (2) 
VXSDOT =B( 3) 
VYSDOT=B{ 4) 
RETURN 
END 


C THIS SUBROUTINE IS USED TO SOLVE A SET Op SIMULTANEOUS 
C LINEAR EQUATIONS 
C 

SUBROUTINE S IMQ { A , B, N , KS ) 

DIMENSION A ( 1) j B ( I ) 

FORWARD SOLUTION 

T QL=0 <>0 
KS=G 
J J=-N 

DO 65 J = 1,N 
J Y= J + l 
J J=JJ+N+ I 
B I GA = 0 
I T = J J-J 
DO 30 I = J , N 

SEARCH FOR MAXIMUM COEFFICIENT IN COLUMN 
I JsIT+1 

I F { ABS ( B I GA ) -ABS t A { I J ) } ) 20,30,3 0 
20 B IGA = A { I J ) 

I MAX= I 
30 CONTINUE 

TEST FOR PIVOT LESS THAN TOLERANCE 

IF(ABSIBIGA)-TOL) 35,35,40 
35 K S = 1 
RETURN 

INTERCHANGE ROWS IF NECESSARY 

40 I I=J +N* ( J-2 J 
I T= I MAX-J 
DO 50 K=J,N . 

i 1 = 1 i +n ; 

I 2=1 l-J-I T 
$ AVE=A { II ) 

A ( 1 1 ) =A (12) 

A ( I 2 5 = SA VE 



non o n n non 
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DIVIDE EQUATION BY LEADING COEFFICIENT 

50 A(I1)=A(I1)/BIGA 
S AVE = B( I MAX ) 

B ( I MAX ) = B t J > 

B I J) =SAV£/8 IGA 

ELIMINATE NEXT VARIABLE 

IFIJ-N) 55,70,55 
55 I GS=N* ( J- U 
DO 65 I X= JY , N 
I XJ=IQS+IX 
I T=J - 1 X 
DO 60 JX=JY,N 
I XJX=N^I JX-D + IX 

J JX= IXJX+IT 

6 0 AIIXJX)=A( IXJX)-(AnxJ)*A{ JJX) ) 

65 B(IX) = 3{IX)-(B(J}#A( IXJJ > 

BACK SOLUTION 

70 NY=N-I 
I T=N*N 

DO 80 J = 1 ,NY 
I A=I T- J 
I B=M— J 
I C=N 

DO 80 K=1 , J 

B( IB ) = B( IB}-A{ IAi*8{ IC) ■' 

I A = I A- N 
80 IC=IC-I 
RETURN 
END 



